from machine import Pin,PWM
import time

#右轮
p13 = Pin(15, Pin.OUT)
p12 = Pin(4, Pin.OUT)
right_pwm= PWM(Pin(5))
right_pwm.freq(1000)

# 控制1个电机
#左轮
p14 = Pin(14, Pin.OUT)
p27 = Pin(27, Pin.OUT)
left_pwm= PWM(Pin(26))
left_pwm.freq(1000)

def forward():#前进
    # 2个电机朝1个方向转2秒（前进）
    right_pwm.duty(900)
    p12.value(1)
    p13.value(0)
    left_pwm.duty(900)
    p14.value(1)
    p27.value(0)
    time.sleep(2)
    # 不动
    p12.value(0)
    p13.value(0)
    p14.value(0)
    p27.value(0)
def backward():#后退
    # 2个电机朝1个方向转2秒（后退）
    right_pwm.duty(900)
    p12.value(0)
    p13.value(1)
    left_pwm.duty(900)
    p14.value(0)
    p27.value(1)
    time.sleep(1)
    # 不动
    p12.value(0)
    p13.value(0)
    p14.value(0)
    p27.value(0)
def left():#左转
    # 2个电机朝1个方向转2秒（左转）
    right_pwm.duty(900)
    p12.value(1)
    p13.value(0)
    left_pwm.duty(900)
    p14.value(0)
    p27.value(1)
    time.sleep(1)
    # 不动
    p12.value(0)
    p13.value(0)
    p14.value(0)
    p27.value(0)
def right():#右转
    # 2个电机朝1个方向转2秒（右转）
    right_pwm.duty(900)
    p12.value(0)
    p13.value(1)
    left_pwm.duty(900)
    p14.value(1)
    p27.value(0)
    time.sleep(1)
    # 不动
    p12.value(0)
    p13.value(0)
    p14.value(0)
    p27.value(0)
